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[57] ABSTRACT 

An apparatus and a method for generating acceleration 
and deceleration patterns for control of a robot in a 
servo system which is equipped with a plurality of driv- 
ing axes so constituted as to mutually exert dynamic 
interference, in such a manner that a synchronism is 
attained at acceleration start points, velocity peak 
points and deceleration end points in the patterns for the 
individual driving axes. Peak time calculating means 
responds to the information relative to dynamic param- 
eters from constant setting means and command means, 
and calculates the peak time, which is required until the 
velocity reaches its peak after the pattern generation 
start point, from the kinetic energy consumed for each 
displacement and also from the power distribution rela- 
tive to the driving sources. And pattern generating " 
means generates, on the basis of the peak time thus 
obtained, an acceleration pattern and a temporally re- 
flected deceleration pattern for each driving axis, 
whereby the tact time required for each displacement 
can be minimized. 

/** 

6 Claims, 8 Drawing Sheets 




10/24/2003, EAST Version: 1.4,1 



U.S. Patent juiy 19, 1994 sheet 1 of 8 5,331,542 



FIG. I 



COMMAND 
MEANS 



r 



SIPRM) 



S(PRM) 



4b 



S(Tp) 



Tp sei 

MEANS 


TING 


t 



1 



L 



ENERGY 
i>j COMPUTING 
MEANS 

—^i r 

4a 
S(CNS) 



CONSTANT 

SETTING 
MEANS 



^5 



CONDITION 

DECIDING 

MEANS 



5b 



FUNCTION 

COMPUTING 

MEANS 



5a 



SYMKCTRIZING 
MEANS 



5c 



ACMORT MEANS 



/6(l) 



SERVO 
QRCUIT 



7(1) 1 8(1) 

iSERVO SrSTEM L 

IFOR RRST ARM , DRIVING 



I ' 




SERVO SYSTEM 
FOR SECOND ARM 



6(2) 



10/24/2003, EAST Version: 1.4.1 



U.S. Patent 



July 19, 1994 



Sheet 2 of 8 



5,331,542 



FIG. 2 



(b) 



(a) 


SET RftRAMETERS 
AND CONSTANTS 









FIND PEAK TIME Tp 

1 ) CALCULATE E^ERC5y 
EXPRESSIONS 

2) PRESCRIBE PCMER 
DISTRIBUTION 

3) COMPUTE Tp VALUE 
FOR ARMS 

4) DETERMINE Tp VALUE 



(C) 



GENERATE ACCELERATION 

ANDDECELKATION 

PATTERNS 

1) GENERATE 

ACCELERATION RlVTTERNl 

2) GENERA7E 
DECELERATION WVTTERN 



(1nd_J) 



10/24/2003, EAST Version: 1.4.1 



U.S. Patent 



July 19, 1994 



Sheet 3 of 8 



5,331, 



FIG. 3 



Y 





























X 



FIG. 4 




10/24/2003, EAST Version: 1.4.1 



U.S. Patent 



July 19, 1994 



Sheet 4 of 8 



5,331,542 



FIG. 5 

Q 



i 



0 



7777T 



h- 



FIG.6 




MOTOR 



10/24/2003, EAST Version: 1.4.1 



U.S. Patent juiy 19,1994 sheets of 8 5,331,542 




FIG.8 




10/24/2003. EAST Version: 1.4.1 



U.S. Patent July 19, 1994 sheet 6 of 8 



FIG. 9 



W2m 




10/24/2003, EAST Version: 1.4.1 



U.S. Patent 



July 19, 1994 



Sheet 7 of 8 



5,331,542 




10/24/2003, EAST Version: 1.4.1 



U.S. Patent July 19, 1994 sheet 8 of 8 5,331,542 



FIG. I2A 




FIG. I2B 



bz • b 




10/24/2003, EAST Version: 1.4.1 



5,331,542 

1 2 

ent depending on the relationship between the arms bl 

METHOD AND APPARATUS FOR GENERATING and bZ With respect to the moment of inertia at the 

ACXXLERATION AND DECELERATION center of rotation of the first arm bl. the moment in the 

PATTERNS FOR ROBOT CONTROL situation shown in HO. 12A is greater than that shown 

B^^rr^n^wT^TT. ^ ^ P^G- SO greater power is needed m the 

BACKGROUND OF THE INVENTION former even though the two motions have the same 

1. Field of the Invention displacement Adl. A longer time is also required before 
The present invention relates to a method and an the movement comes to a halt. 

apparatus for generating acceleration and deceleration That is to say, if the acceleration and deceleration 

patterns for control of a robot in a servo system which patterns for each arm are generated using the same 

is equipped with a plurality ot driving axes so consti- concept as that applied to orthogonal type robots irre- 

tuted as to mutually exert dynamic interference, in a spective of the circumstances, it follows that the same 

manner to shorten the required time of movement by peak time Tp is used in both of the situations shown in 

such patterns adequate to draw out the majumum power i2A and 12B. 

from a driving source. " jijeygfoyg^ ^obot b is actuated with a greater Tp 

2. Description of the Prior Art value as csompared with the situation shown in FIG. 
One of the effective mdexes m exanumng the kmetic lengthens the tact time (2Tp). 

capability ofa robot is a workmg^^^ In an attempt to eliminate such a disadvanuge. it is 

ble that the tact time is nnmmued and that no unneces- j^le to consider changing the peak time Tp in ac 

"^om^rth^^^^^^^^^^^ heretofore for " ^^^^^ ^^'of the 

minimizing the uct time. One of them is carried out by „ ' * j * • t i. 

optimizing an acceleration-deceleration curve relative However correct dctcrmiMtion of such a change 

to a servo system requires a lot of expenence and is highly dependent on 

First, with reference to FIGS. 10 and 11. a brief dc- 25 the operator's level of experience and ability. Even if a 

scription will be given on the exemplary method pro. satisfactory result is attained, there still remains the 

posed by the present applicant as disclosed in Japanese possibility that the best selectable setting is not achieved 

Patent Application No. Hei 2 (1990)-283867, now Japa- that some additional operations may be needed in 

nese Published Application No. 4-157508. the normal operation fails to completely meet the 

Denoted by a in FIG. 10 is an acceleration-decelera- 30 requirements, 

tion curve, where the time required for the velocity o For example, it may be possible to contrive a method 

to reach its peak value (op) from an acceleration start of first dividing the operations into a number of proba- 

instant (t=0) is termed "peak time" (hereinafter abbrc- ble cases, empirically determining optimal Tp values for 

viated to Tp), and in contrast with an acceleration pat- each case, subsequently writing the optimal values into 

tern until such peak time, a deceleration pattern is ob- 35 ROMs or the like, and using such values as references in 

tained by execution of a temporal reflection with re- generating acceleration and deceleration patterns, 

spect to t=Tp. However, a lot of complicated work is necessary in 

The acceleration-deceleration curve a is determined order to complete the ROMs» and such must be re- 

by changing the peak time Tp in accordance with the peated during the development of every new robot, 
displacement. 40 

More specifically, as shown in FIG. 11, there is previ- OBJECT AND SUMMARY OF THE INVENTION 

ously prescribed the characteristic with respect to the is therefore an object of the present invention to 

displacement and the peak time Tp, and in generat- provide an improvement which is capable of generating 

mg acceleration and deceleration patterns, first an ac- acceleration and deceleration patterns by dynamically 

celeration pattern is generated m such a manner that the 45 analyzing the motion of a robot, representing the mu- 

ome required for the veloaty to reach the peak value .^^j interference of arms by logical expressions, and 

from the acceleration start pomt becomes equal to the calculating the appropriate peak time with regard to the 

peak tmie correspondmg to the dispkcement, and there- ^^^-^^ therefrom 

after a deceleration pattern is generated by the tech- ^- « *u ^ * • j 

nique of temporal symmetrization. 50 to the present mvention. dynamic con- 

Although the method mentioned above is considered ^^"^^ ^ f "^^^;^> ^P^^^*^^ t.^'T 

to be sufficiently effective in a servo system in the situa- • ^^^^ ^ "^^"^l means while dy- 

tion wherein there is no dynamic interference between n^niic parameters, such as the start and end pomts of 
a plurality of driving axes as in an orthogonal type f^^^ displacement, are designated by command means 
robot, a problem arises in the case such a method is 55 «>£«Ponsc to instructions for the displacement, 
applied to a multiaxial scalar type robot. Followmg this, a peak time calculatmg means calcu- 

FIG. 12 schematically shows the motion of a biaxial ^^^s the peak time on the basis of the above information 
scalar type robot b. In this robot, a second arm b2 is ^^^s the peak time. 

rotatably connected to the fore end of a first arm bl. ^ ^ stage, an energy computing means which 

FIG. 12A shows the situation wherein the two arms 60 Part of the peak time calculating means expresses 
bl, b2 have rotated through an angle A^l with the two dynamic parameters as functions of peak time, and 

arms bl and b2 lineariy extended, and FIG. 128 shows computes the entire kinetic energy required for the 
the situation after rotation through an angle of A^l with displacement as a function of the peak time. The energy 
the second arm b2 at an angle with respect to the first computing means determines a driving source from 
arm bl. In both cases, the rotation angle Ad2 of the 65 which each energy term is supplied with a power, and 
second arm b2 is zero. derives the peak time by equalizing the relevant energy 

As will be understood by careful observation of the term with respect to the maximum power value allow- 
motions of both arms, the control aspect becomes differ- able by the driving source. 
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Suteequenlly. a peak time setting means which fonns DESCRIPTION OF THE PREFERRED 

part of the peak time calculating means selects, as the ^^^^^Mnonil^K^^ 

peak time of the entire system, a maximum from the tMUUUiMtiN i :s 

peak time values thus obtained with respect to the indi- Prior to describing the acceleration-deceleration pat- 

vidua] driving axes. ^ ^ni generating apparatus of the present invention, ex- 

Thereafter, a pattern generating means generates planation will first be given of the principle of the in- 

acceleration and deceleration patterns on tiie basis of vention. This explanation wUl be based on physical 

the selected peak time. More specifically, an accelera- analysis, with reference to an exemplary biaxial scalar 

tion pattern relative to each driving axis is generated in ^VP® ^^^^ ^ controlled. . ^ ^ . 

such a manner that the time required for the velocity to , present mvaidoa the operation of a robot is 

reach its peak value from point in time where tiie accel- dynamicaHy analyzed, and the mutual interference of 

eration starts becomes equal to the value obtained by ^ the mfluence of the monon of one arm upon 

tfie peak time setting means. Following this, a tempo- ^ represented by logical expressions. 

ii n*jj ^ xji.* These logical expressions are then utilized for determm- 

rally reflected decelerauon pattern is genera ed by tern- ,5 . ^ ^ shortening tiie tact time, 

poral symmetnzation of the acceteation pattern. 3 ^^^^ ^ ^^-^^ ^^^j^ of a biaxial 

According to tiie present invention, tiie acceleration ^^^^^^ ^^^^^^ ^ ^^^^ ^^^^ ^^^^^^ ^^^^^ 

and deceleration patterns can be optiimzed by modehng ^ ^^gin O of X-Y orthogonal coordinates, while a 

tiie servo system with respect to tiie mutual dynamic second arm b2 is rotated about a rotational end (point 

interference of arms, using energy based logical expres- 20 q') of the first arm bl. 

sions, the power of the driving source and the power Parameters relating to tiie two arms bl and b2 are 

distribution, and then calculating the optimal value of defined m Table 1 below, 
the peak time Tp. This reduces the tact time by efn* 
ciently utilizing the power of the driving source. 

As the algorithm is logically definite, there is no need 
for the operator*s ability or experience to intervene. 
Furthermore, it is no longer necessary to acquire huge 
amounts of experimental data for each individual robot 
and to utilize such data for control. 

The above and other features and advantages of the 
present invention will become apparent from the fol- 
lowing description which will be given with reference 
to the accompanying drawings. 

BRIEF DESCRIPTION OF THE DRAWINGS ^5 

FIG. 1 is a block diagram of an acceleration-decelera- 
tion pattern generating apparatus embodying the pres- 
ent invention; 

FIG. 2 is a flow chart of an algorithm executed by the 40 It is to be noted that the angle parameter $2 is not 

acceleration-deceleration pattern generating method based on the angle formed by the center axis of the 

according to the present invention; second arm b2 with the X-axis, but on the measured 

FIG. 3 shows a modeled motion which is typical of a angle formed in the X-Y plane by the center axis of the 

biaxial scalar type robot; second arm b2 with that of the first arm bl. 

FIG. 4 graphically shows an exemplary acceleration- 45 In the following dynamic analysis description, the 

deceleration curve; robot system is idealized by adopting the assumptions 

FIG. 5 is a schematic diagram showing the configura- and approximations listed below, so as not to unneces- 

tion of a motor driving circuit; sarily complicate the explanation: 

FIG. 6 is a circuit diagram of the motor driving cir- (0 is assumed that there is no viscosity term, 

cuit; ^ (?) I^ is assumed that each robot arm is precisely respon- 

FIG. 7 is a plan view showing tiie structure of a sive to any command value for servo control, 

biaxial scalar type robot; * (3) ^ assumed that energy which is converted into 

FIG. 8 is a conceptual diagram showing energy and dissipated is negligible and is ignored, 

power distributions' acceleration-deceleration curve used, the 

FIG. 9 is a two-dimensional graphic representation " acceleration^eceleration patterns are symmetrized 

• showing the power of each driving motor; temporal rcflccUon. 

FIG. 10 graphically shows an example of accelera- ^V^^ P°^,^^ consumption of an arm 

tion and deceleration patterns which are generated witii ^"1:^8 "'^^^^ acceleration and dunng decel- 

respect to one driving axis- eration arc equal to each other. 

„ . • ^, t.. . , ^ First the kinetic energy in the robot system shown in 

F G. U raphically hows the relat,onsh.p between , ^^^^^^ ^'p,Q 3 j^Jp, „^ 

i? r rf,"l /t'?nT'*".- ,. represented by polar coordinated where the X-Y coor. 

FIGS. 12A and 12B schemat.caUy show the motion jj^^j^ „^ „ , ^„ ,„ j,^^ ^„ ^^^^^ 

of a biaxial scalar type robot discussed in the opening 3^ ^ -^nary axis). The position of 

paragraphs of the instant disclosure wherein FIG. 12A 65 each point can then be expressed as: 

shows the robot arms rotated in a linearly aligned state, 

and wherein FIG. 12B shows a second situation in n-Gl<xpV-9l) 

which the arms are rotated in a mutually rotated slate. 



TABLE 1 




Definitions of Paraineiers, etc. 


Symbol 


Meaning 


PI 


Position of InertiaJ center of first arm 


P2 


Position of ineitlal center of second arm 


Ll 


Length of fust arm 


Gl 


Distance from origin 0 to point PI (OPI) 


L2 


Length of second arm 


G2 


Distance from point O' to point P2 (OP2) 


0\ 


Angle formed by center axis of first arm with 




X-axis 


ei 


Angle formed by center axis of second arm with 




that of first arm 


Ml 


Mass of first arm 


M2 


Mass of second arm 


11 


Inertia moment of first arm (aroand PI) 


12 


Inertia moment of second arm (around P2) 
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«=ti«p (i.fli)+G2<xp [m +62)] (1) using such differentials, into three terms, i.e.. a square 

term of the velocity ol, a square term of the velocity 
where i doiotes an imaginary numerical unit. and a term of the product of the velocities ol and 

Calculations of the velocities at the points PI and P2. ^2 
involves linear differentiation executed with respect to 5 ^ (4) ^presents the energy of the entire system 
time t as follows; ^^len the first arm bl is moved at the angular velocity 

0)1 while the second arm b2 is moved at the angular 
r / NT velocity <d2 up to the position with 02. 

^ = Ci-^.exp /.f«i +«2-J The constants (A1,A2,B1, CI, C2) in Eq. (5) are the 

^ 10 values specific to the robot system. 

For the purpose of simplifying the explanation, we 
dF2 _ d$\ . gjjp L . ^ •2-^1+ consider the triangular pattern of FIG. 4 as an 

^ * L \ ^ / J acceleration-deceleration curve for controlling the mo- 

tions of the arms bl and b2. 
✓ \ r ✓ N -I 15 In the graphic representations shown in FIG. 4 where 

G2 . ( + "rfT )• exp M • f «i + W + y J J the angular velocities <ol, cd2 are plotted on the ordinate 

and the time t plotted on the abscissa, in one illustrated 
— , . . pattern, the velocity cdI rises from the origin with a 

•niekmetic energy E(«ai) of the entire system is rcprc- (acceleration is constant) and. after reaching 

sented by the sum of the translational lonenc energy 20 the peak value c.l(P) at a point t=Tp. decelerates with 
relative to the arms bl. b2 and the rotational energy ^ ^^^^ terminate at a point t=2.Tp. Mean- 

arouna eacn ccntroio. ana is given t>y: 

in the other illustrated pattern, the velocity 6)2 
rises with a fixed slope from the origin and, after reach- 

1 1^ ✓ ing the peak value a)2(P) at the point t=Tp, then decel- 
£(all) = . Ml . I + -J- • /I • f J + 25 crates and terminates at the point t = 2-Tp. 

^ Thus, each pattern is linearly symmetrical with re- 

2 2 ^P^^^ point t=Tp. and the acceleration pattern 

X . • I I + -L , n . r + JSL\ ^® deceleration pattern are so formed as to be 

2 * ' I I 2 ' \ di di J mutually superposed by temporal reflection. Both arms 

are retained in synchronism with each other relative to 
On the right side of Eq. (3), the first term corresponds acceleration start point, the peak point (t =Tp) of 

to the translational kinetic energy of the first arm bl. the the angular velocity, and the termination point (or de- 
second term to the rotational energy around the point celeration end point). 

PI. the third term to the translational kinetic energy of The energy E(all:P) of the entire system at the peak 
the second arm b2, and the fourth term to the rotational point (t=Tp) of the angular velocity in such accelera- 
energy around the point P2, respectively. tion and deceleration patterns is obtained by substitut- 

The values relative to the terms including the linear ing o)l=o)l(P), q>2=6>2(P) and Ws=d2(P) (value of W 
differentials of the points PI and P2 with respect to time at ts=Tp) for Eq. (4) and it is calculated as: 
are squares of the absolute values thereof, signifying 

that the linear differential terms are multiplied by the i r ,,-.0 (6) 

respective complex conjugates, whereby Lh uL is ^'^^^'^ ^T'^'^^^' «'««<'^> ' l^'^'^l' + 
converted into a real number. (This process is necessary 

because the X-Y coordinate system is taken as being a y -ffi • {to2{F)f + y - (a + C2 . cosW(/o) • e>i(/o • w2(P) 

complex plane.) 

By substituting Eq. (2) into the right side of Eq. (3). jhus, Eq. (6) represents the entire dynamic energy 
the energy E(all) can be expressed as: B(3i\:?) when the angular velocities tul. o2 have 

reached the respective peak values <d1(P), ci>2(P) simul- 
£(all) « . (/<i + i42 . cose2) • + taneously, and such energy E(aIl:P) is supplied naturally 

^ 50 from the arm driving mechanism. 

1 . 1 When the robot system proceeds to the deceleration 

y . ^1 . (cu2)^ + y . (a + C2 . cosW) - oil cdZ . ^^^^ ^^^^ ^j^^^^ ^^^^ E(all:P) IS re- 
tained, if the arm driving mechanism is so designed as to 
be capable of reusing such energy, it becomes possible 
_ de \ SS to operate the robot system from the deceleration start 

^ ~ it point to the termination point without the necessity of 

supplying any new energy (on condition that any loss 
»2 =s derived from the friction is neglected). 

In any practical driving mechanism, however, such 
AX • + J\ + Ml' Li^ + m-Ol^ -¥ n (5) ^ reuse of the energy is impossible and, to the contrary, 
^ I jln^j'V energy substantiaUy equal to E(all:P) is consumed at the 

a ^ 2 * m ' Gi^ + 2 ' n ^ 2' B\ time of deceleration. For example, in a bridge type 

C2^2'm'L\'Gl = A2 motor driving circuit of FIG. 5, energy substantially 

equal to the above is consumed during each accelera- 
As demonstrated by Eq. (5) the time differentials per 65 tion and deceleration event, 
rotation with respect to the angle parameters 01, 02 are It follows that double the energy E(all:P) is required 
defined as angular velocities col, 0)2 respectively. As for the robot system over the stages of acceleration and 
will be understood the energy E(all) can be divided, deceleration. 



where: 
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Accordingly, with reference to the total power W of 
the motors to drive the arms bl and b2, the energy 
W.(2Tp) supplied during the time up to 2 Tp is sup- 
posed to be equal to the required energy 2*£(all:P). 
Therefore the relationship represented by Eq. (7) below 
is obtained: 



A8I 



Eq. (9) is obtained by substituting Eq. (8) for Eq. (6) 
to solve for the peak time Tp. Meanwhile, Eq. (10) is 
obtained by substituting Eq. (8) for Eq. (6) to solve for 
the peak time Tp. 



the resistance loss, and the second term thereof repre- 
sents the dynamic energy of the motor. 



(13) 



The energy 2«E(all:P) is given by the time integral 
(interval 0^t^2Tp) of the second term of the right 



(7) side of Eq. (13). It is expressed as: 



Since the enclosed area between the acceleration- 
deceleration curve and the time axis in FIG. 4 corre- 
sponds to the angular displacements tBl and A92| 



10 



■I" 

J 0 



tildt 



04) 



(8) 



IS 



20 



It is to be noted that, in the right side of Eq. (14), the 
current I is fixed and is out of the integral since the 
acceleration in the acceleration-deceleration curve is 
fixed, and the integral becomes double the value in the 
interval (023 1 = Tp) due to the symmetry of the acceler- 
ation-deceleration curve. In the acceleration-decelera- 
tion curve of FIG. 4, the acceleration panem can be 
expressed by a linear expression of Eq. (IS) having a 
fixed slope as: 



W 

[A\ + A2 » cosg2(/0] > {A9\f + B\ . (^02)3 4 [a Q * cos02(J)] . (API) ■ (Ag2) 



3 [Al^-At* cos92{Pi] » iL9\9 ^ B\ ' (A02)^ -h [O -t- C2 ■ cose2(/)] - (Agl) ■ (Ag2) 



(10) 



Eq. (9) represents Tp by the parameters 

02(P)) and the energy E(all:P) when the arms bl and b2 „, ^ oUPi , , (15) 
are displaced in accordance with the acceleration- 
deceleration curve of FIG. 4, in which A61 and A^2 are 

the respective displacements of the arms bl and b2, and Therefore an integration is executed with substitution 

AO! (P) is the position where the velocity of the second of Eq. (15) for Eq. (14) and, after 6)l(P>Tp is replaced 

arm b2 reaches its peak (t=Tp). This equation is useful with Adl according to the first expression of Eq. (8), the 
for determining the dynamic constants Al, A2, Bl and ^ result thereof is substituted for Eq. (11) yielding Eq. 

so forth. (16) as follows: 

When the robot is so driven as to perform a recipro- 

cative motion without a pause, the entire energy per . (16) 

reciprocation is 2*E(all:P), so that the peak time Tp is « M '^^^ 

given by Eq. (9). N jr£(i).y 

In an exemplary case where AW=0, 62(P)=7r/2 for , ^ . . ^ ^ 

calculating the constant Al, Eq. (11) is obtained by ^^"^^"6 the constant Al by actual measurement 

substituting the above values for Eq. (9). (^^) ^h^ ^^^1 ^^^i^"^ ^?"f^^,^ 

any pause under the conditions of A02=O and 

SO 02(P)=?r/2 with a displacement A01 and a peak time 

"^j— J— J— Tp. The effective current I flowing in the motor is 

Yr^3fj=) • measured and substituted for Eq. (16), whereby the 

constant Al can be calculated. (In this case, KEO) is 

Eq. (1 1) represents an aspect where the first arm bl assumed to have a known value.) 

alone is actuated in accordance with the triangular ac- The constants A2 and Bl can also be calculated by 

celeration-deceleration curve. actual measurement in the same manner as the above. 

FIG. 6 is an equivalent circuit diagram relative to the As for the calculation of the constant A2, Eq. (17) is 

motor for the first arm bl. With respect to this circuit, obtained under the conditions wherein ^02^0 and 

Eq. (12) represents the relationship which exists be- w2(P)=0. MeanwhUe the constant Bl. Eq. (18) is ob- 

tween voltage V, cunent I, internal resistance R, coun- ^ tained under the condition wherein A^l^D. 

terelectromotive force constant K£0)t and angular 

velocity o)l. (17) 



A (A\ + A2)^m 



VJ^fi-R+KE^rhM (12) ^^>>- 

(18) 



6S 



Multiplying the two sides of Eq. (12) by dt forms Zq. I . 

(13). The left side of this equation represents the supply ~ \| ke{2) • J 

energy, while the first term of the right side represents 
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The constants Al and A2 can be calculated by solv- 

ing Eq. (17) and Eq. (16) simultaneously. As for Eq. C=Ci+C2<ose2(lO (20) 
(18), the desired result is obtained by measuring the 

effective current while repeating the motion of the ^ Eq. (20), new constants A. B, C are used in place 

second arm b2 alone, (In this case, the counterelectro- 5 of the former constants in order to simplify the form of 

motive force constant KE(2) relative to the second*arm expression. 

driving motor is assumed to have a known value.) However, a problem is encountered in that it is not 

After the constants Al, A2 and Bl have thus been ^^^^^ which technique is needed to shorten the uct time 

obtained, the remaining constants CI and C2 can be under the conditions pertaining to Eq. (19). This prob- 

calculated with ease from the relationship of C1=2-B1 10 lem will now be discussed. 

and C2=A2 in Eq. (5). In order to find the value of the power W (i.e. maxi- 
Such constants originally have values which can be >°um W) to minimize the peak time Tp in Eq. (19), 
derived by calculation if the dynamic parameters and ^^^^ operating the robot in accordance with the accel- 
the like are exactly known as given in Eq. (5). Practi- erationniecclcration curve (FIG, 4) in a manner which 
cally, however, there exist some difficulty in accurately 15 induces displacements A^l and Ad2 of the arms bl and 
calculating the centroid position and the like. In view of b2, the boundary condition of Eq. (21) must be satisfied, 
such practical difficulties, the above method of calculat- 
ing the constants on the basis of the actual motion of the *^ ABZ^O 
robot is considered to be simpler and superior in that it w iw* v a-i a 

reflects the robot motion more faithfully. 20 ^ ^"^^^ <2l) 

Since sequential preparations have thus been com- „u«„« u«.,«j««. • .u * l 

p.e.ed U»ro„gh the d^an,ic^ ana,y«s relative to the onlS tfe^^Lt^t^^o^e^^rtaSe"^^^^ 

rstSce'oT^': 0^^^^^^^ " - *e output of 

Eq (10) represents the relationship between the peak 25 gince the power W is obtained as a solution to the 

Tp and the power W of the dnvmg motors of the ^ecLes possible to operate the robot with a 

arms bl and b2, as will be understood from the process „t„;J,„„^^i,^„^u » .v ""f " 

of deriving the equation. nnnimum peak time by utUumg the power of the dnv- 

Aswillbeunderstoodfromtheexpre^ionwherethe '"'tTI^:!' "IIITZ^^^^ • f.K- s, • 

power W is placed in the denominator of thecubic root. 3° .hP^^t^.^rf'^^^^X • - Z t T 

Ae tact Ume (=2.tp) can be reduced by increasing the ^^^i^ Ihr^.Tll 2"' Tt'^h ^k""' ^ 
power W robot with the maximum output of both arm dnving 

However, it is impossible to increase the power W *^ *v:.. ♦ *i. ^ ^ 

♦ r 1 • «f • J. 1^ Accordmg to this concept, however, the desired 

mfimtely since the power Wis the sum of the respective tu^ 1 i -♦•^ \i i V* 

»/x»,«» ^rtk. r^. ui kt 35 synchromsm between the acceleration-deceleration 

powers of the dnving motors for the arms bl and b2. ^^^^^ ^^^^^ ^ . ^ j 

rig^hirir^±^^ represented by Eq. further it is not clear whether the outputs of the tiotors 

;?o«t^ Wl fnTfhr^^^^^ P^^P^^^y ^'^Snc6 to the individual terms of the 

the output Wl and the maximum output Wlm of the ^ght side of Eq. (20). 

dnving motor for the first arm bl and also to the output r^u^A««« Tul lu/,.- ^. ui c r n 

wy ^..t^»* ^r*u^ ^-i.j * 40 Clarifying the above problem further, the foUowmg 

W2and themaximum output W2m of the dnvmg motor ^^^^^^^ achieved 

for the second arm b2. ^^^^^ ^^^^ ^^^^^ ^ 

w^m-i-WlSWim-hU^m displaced from one position to another, the energy re- 

quired for the displacement is as mentioned 2-E(aIl:P). 
^here: 43 1^ energy is supplied from the two arm driving 

motors for the time of 0^t^2*Tp during which, as 
wi^wim given by Eq. (7), the robot is in motion, so that the 

above energy is equal to the value obtained by multiply- 
W2SW2m (19) ing the energy W per unit time by the required time 

50 2-Tp. 

The condition includes a restriction that total power If the energy can be completely transferred between 
W should not exceed the sum of Wlm-|-W2m, and • the two arms in such a manner that the energy of the 
simultaneously a restriction that the individual powers driving motor for one arm is usable for moving the 
or outputs Wl and W2 of the two motors should not other arm, then the tact time can be minimized by rotat- 
exceed the respective maximum outputs Wlm and 55 ing each driving motor with its maximum output. 
W2m. However, due to the existence of certain restrictions 

In an attempt to simplify the relationship between on the etiergy distribution, the circumstances in actual 
Eqs. (19) and (10), Eq. (10) may be modified to form Eq. practice are different 

(20). It becomes apparent from the following physical 

60 considerations that, with regard to the Hrst and third 
WtnA ^^^'^ B r ^Afl" • ^^gg^ termsoftherightsideofEq. (20), the energy is supplied 

2 . 2 • ^^^^ driving motor for the first arm bl, whereas 

with regard to the second term of the right side of Eq. 
^here: energy is supplied from the driving motor for 

65 the second arm b2, 

A^A\'i'A2<os$2iF) FIG- 7 is a plan view schematically illustrating a 

biaxial scalar type robot, wherein a driving motor M2 
S'^^i for a second arm b2 is firmly secured to a first arm bl. 
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The first arm bl is rotatably connected to an axial quired until energy E2 is obtained while supplying the 

base portion c. Suppose that the servo control for the maximum W2m of the power W2. 

first arm bl is released. Then, in view of the coordinate If the required time El/Wl is compared with the 

system fixed in the axial base portion c, the generated time E2/W2, and the former is longer, it is impossible to 

torque of the motor M2 inclusive of the first arm bl is an 5 further reduce the required time. However, if the latter 

internal force couple, which is incapable of changing is longer than the former, the required time may be 

the angle $1 of the first arm bl. further reducible. 

If the second arm b2 is displaced (rotated) by such This fact is mathematically represented by Eqs. (23) 

torque, it follows that the inertial center of the second through (27). 

arm b2 is also displaced. However, since the inertial 10 First, the time Tp calculated under the condition of 

center of the entire system, including both the first and wi = Wlm in Eq. (22) is defined as Tp(l), and the time 

second arms, remains unchanged (as the torque of the jp calculated under the condition of W2=W2m is 

motor M2 is an internal one) the inenial center of the jefmed as Tp(2). That is. Tp(l) and Tp(2) are obtained 

first arm bl is displaced whereby the angle ei is solutions to satisfy Eq. (23) below: 

changed. • 15 x / 

Consequently, in this case, the power W2 of the 

motor M2 is distributed as the energies for the arms bl mm^A- ^^^^^ + c . (^^^If^^^) ^' 

andb2. 2.[r;<i)p a-ir^op 

Under the conditions wherein the first arm bl is 

firmly connected to the axial base portion (i.e., when 20 wim = B — ^^^^^ 

position servo control is being executed), the second ^ ' i^ifXii 
arm b2 alone is moved and the output power W2 is 

consumed merely for such displacement. The double values of such Tp(l) and Tp(2) corre- 

During the operation of the robot, servo control is spond to the periods of time required for energy supply 

executed on the driving motor for the first arm bl and, 25 in the individual cases. Further, as given by Eq. (24). the 

if such servo control is functionally sufficient, the effect greatest value of Tp(l), Tp(2) and Tp^^^' is selected as 

thereof is substantially the same as that in holding the fmal Tp, where Tp^'^ denotes the minimum peak time 

first arm bl in place. The condition that each arm is derived from the restriction of the frequency (f) charac- 

movable precisely in accordance with any command teristics in the servo control, 

value as mentioned in previously listed assumption (2) 30 

as one analytic premise for the robot system ensures Tp^MAXiTp{\), r^2), 7>*"^ (24) 
such circumstances. 

Summing up the above, as given by Eq. (22) Wl is The values of Wl and W2 are determined by the use 

consumed as the power for the square term of A^l and of Tp thus obtained. 

the associated term of LB\ and Ldl in Eq. (20), while 35 This aspect will now be described below with respect 

W2 is consumed as the power for the square term of to the individual cases depending on the relative lengths 

A«2 in Eq. (20). of Tp(l) and Tp(2). [i\ When Tp= Tp(J) Tp(2) 

In this case, Wl is equal to the maximum Wlm, while 

W ^ W\ Wl (22) ^2 value obtained by substituting Tp=Tp{l) 

40 for the third expression of Eq. (22). The above situation 

m ^A' ^^^^^ + C ^^^^^ • ^^^2) can be represented by Eq. (25) as follows: 



H7 = B 



2.V 



Tfil) (25) 



45 m^mn,^A^^^c- ^^^'>^<T^ 

2»T^ 2 . 



As the essence of the problem is thus rendered obvi- 
ous, a technique for shortening the tact time, i.e. for wim^ j.i^fZiL 
minimizing the peak time Tp, can be achieved. ' l*T^ 

FIG. 8 is a conceptual diagram showing the relation- 50 
ship of the energy distribution according to the above w « m + w = w\m + B • ^^^^^ 

mentioned problem. The total energy 2*£(allJ*) re- * 2.r^3 
quired for operating the robot is composed of £2 for 

displacement of the second arm b2 and El. The energy [ii] When Tp=sTp(2) Tp(l) 
£1 is supplied to induce a power Wl (maximum value 55 In the opposite situation wherein W2 is equal to the 
Wlm) per unit time, while the energy £2 is supplied to maximum W2m, while Wl has the value obtained by 
induce a power W2 (maximum value Wlm) per unit substituting Tp=Tp(2) for the second expression of Eq. 
firoe. (22), then the situation is represented by Eq. (26) below: 

In this case, the powers Wl, W2 are supplied during 
the predetermined time 2*Tp so that the required ener- 60 
gies El, E2 are obtained. The core of the problem re- j. ^ - ^j 

sides in ascertaining how the peak time Tp can be mini- ' 

mized by supplying the power the least number of (a9i>2 (Agn -fAg2) 

tiroes. 2.^ 2. V 

The solution to this problem depends upon the rela- 65 
tionship between the length of the time required until ^ _ _ 

energy El is obtained while supplying the maximum ~ ~ i-T^ 

Wlm of the power Wl, and the length of the time re- 
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-continued contribution of the power of each arm driving 

w^m^m^A ^ r (Aen.(Ae2> ^ ^ to each term of the energy expression is dynami- 

m -i- m-^A • ^ ^3 + * 2^^3 ' + »^ cally analyzed. 

' ' (b-3) Calculation of Tp value per ann. 

Riil When Tp=Tp(l) Tx>(2) ^ prescription of the power distribution, there are 

Inthiscase,£>th WlMd w/areequaltothemaxima ^?A''^V?fx'^^'^i° ^' temporary Tp values 

thereof rcjrctivcly. as represented by Eq. (27) below: ^P^*^' ^^^^^^ P?^"" ^ ' 

»uwwi itaHswiiYwj, «» «|ij«wiicu oy cq. ^a/; ociow. ^j^^ maximum output of the relevant motor. 

T a>rp(l)-7X2) Determination of Tp value. 

' 10 The maximum out of some Tp values mentioned 

w\= mm above is selected as a practical Tp value. 

(c) Generation of acceleration and deceleration pat- 
wi^W2m terns. 

As for specific generation of the pattern, it is possible 
w=mm+w2m (27) |5 to adopt the method proposed by the present applicant 

in Japanese Patent Application No. Hei 2 
FIG, 9 graphically shows the powers of the driving (1990).283867. now Japanese Published Application 
motors and facilitatmg a visual appreciation of situa- No. 4.157508. Merely the principal point thereof wUl 
tions p) through [iii], Wl is taken along the abscissa and now be described below. 
W2 along the ordinate. 20 (c-1) Generation of acceleration pattern. 

As IS obvious from Eq. (19) mentioned above, the First, an acceleration pattern represented by the use 
region allowable as a variability domain of WI and W2 of a function standardized with regard to a displace- 
is a rectangular area (including the boundary) in FIG. 9 ment is prepared. The peak time in the pattern is set to 
defined by the origin 0 (0, 0), point A (Wlm, 0), point B a predetermined value. 

(0, W2m) and point C (Wlm. W2m). The point A corre- 25 In generating the acceleration pattern, a desired func- 
sponds to the former of the two boundary conditions tion is obtained through multiplication of a standard 
given by Eq. (21) i.e. W=:Wl=Wlm, W2=0 ({W=0); function by the displacement (strictiy, by a proportional 
and the point B corresponds to the latter boundary coefficient for correction of the displacement), and a 
conditions of Eq. 21, i.e. W=W2=W2m, W1=0 temporal scale conversion is executed for the standard 
(A^1=0). For example, the point A includes the aspect 30 function by using, as a conversion parameter, the ratio 
shown in FIG. 12, wherein the difference between the of the Tp value, which is the result of the calculation in 
states of the arms in (a) and (b) is expressed by the cos (b), to the standard Tp value. Namely, in comparison 
term of the coefficient A in Eq. (20). with the known method disclosed in the cited Japanese 

Situations [i] through [iii] (mentioned above) are posi- Patent Apphcation No. Hei 2 (1990)-283867, now Japa- 
tioned on the boundary where Wl=Wlm and 35 nese Published Application No. 4-157508, where the Tp 
W2= W2m. In such states on this boundary, the power value is prescribed on the basis of the displacement, the 
for the driving motors can be drawn out most effidentiy present invention is based on the concept that the opti- 
to minimize the tact time. mal Tp value is prescribed on the basis of the dynamic 

The point A on the line of Wl= Wlm represents [i]; analysis of the robot system, 
the point B on the line of W2=W2m represents pi]; and 40 (c-2) Generation of deceleration pattern, 
the point C at the intersection thereof represents [iii]. A predetermined procedure is carried out to form a 

The solution for minimizing the tact time has thus curve temporally symmetrical with the acceleration 
been obtained. Hereinafter a description will be given pattern. That is, a deceleration pattern is generated by 
on a method and an apparatus for generating accelera- causing changes of velocity which are exactly reverse 
tion and deceleration patterns based on the above the- 45 to those of the acceleration pattern, 
ofy- Such acceleration and deceleration patterns are gen- 

Prior to explaining the construction of the apparatus, erated for each of the arms. (See FIG. 4) 
a control mode will first be described below, including It is particularly noted that, in the present invention, 
a summary of the considerations given above. there exists no restriction on any concrete form of the 

The acceleration-deceleration pattern generating 50 acceleration-deceleration curve, 
method of the present invention is broadly divided into More specifically, the form of the acceleration-decel- 
the following three procedures as shown in FIG. 2. • eration curve is not limited merely to the aforemen* 

(a) Setting of parameters and constants. tioned triangular one which ss given merely as an exam* 
The dynanuc constants (Al, A2, Bl, etc.) and the pie in the above discussion. Since the expression corre- 

maximum output values (Wlm, W2m) of the driving 55 sponding to Eq. (23) becomes relatively complex, it 
motors are set in advance. Thereafter, such values are becomes possible to solve the peak time Tp algebra- 
kept unchanged. The dynamic parameters {^61, A02, ically as given by Eq. (9) or (10). However, Tp(l) and 
etc.)t conforming with commands for operating the Tp(2) can be calculated by numerically solving the 
robot, are set to proper values in response to each com- general expressions F(Tp)=Wlm and G(Tp)s=W2m 
mand. 60 relative to Eq. (23). However, such mathematical prob- 

(b) Calculation of peak time Tp. lems are not an essential feature of the present inven- 
The discussion developed hereinabove is concerned tion. 

mostly with a logical explication of this calculation. The FIG. 1 is a block diagram showing an example of an 
essential points therieof are summarized as follows. apparatus for carrying out the pattern generating 

(b-1) Calculation of energy expression. 65 method mentioned above. 

The energy of the entire system represented by Eq. As shown in the diagram, the acceleration-decelera- 
(4) is calculated from the dynamic analysis of the robot. tion pattern generating apparatus 1 comprises a com- 
(b-2) Prescription of power distribution. mand means 2, a constant setting means 3, a peak time 
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calculating means 4 and a pattern generating means 5, decision relative to the pattern generation, an instruc- 
wherein a control signal relative to a generated acceler- tion is output to the function computing means Sa 
ation-deceleration pattern is output to a servo system The acceleration-^leceleration pattern generation is 
6(1) for a first arm bl and also to a servo system 6(2) for performed in parallel with the arm driving axes, and the 
a second arm b2. 5 control values obtained as a result of the pattern genera- 

Practically, the individual components which com- tion, are output to the servo systems 6(1) and 6(2) re- 
prise the acceleration-deceleration pattern generating spectively. 

apparatus 1, may be implemented by software; and it is Of the control values delivered from the function 
the functions thereof which are visually shown in the computing means 5a, the value relevant to control of 
diagram. 10 the first arm bl is supplied to a servo circuit 7(1) of the 

The command means 2 is responsive to each robot servo system 6(1). whereby the rotation control of a 
operating command and delivers a command signal ™otor 8(1) is executed in conformity with one accelera- 
S(PRM) in the form of a predetermined dynamic pa- tion -deceleration curve of FIG. 4 (having a higher 
rameter such as A^l or ^62, to the peak time calculat- P^^)* ^^^^ >s actuated via a dnvmg 

ing means 4 and the pattern generating means 5. mechanism 9(1). ^ , , , ^ . 

The constant setting means 3 serves to set predeter- Smce the servo system 6(2) for the second arm b2 is 
mined dynamic constants (Al. A2. Bl. etc.) and maxi- stnicturally the same as the servo system 6(1), the mter- 
mum outputs (Wlm, W2m) of the driving motors. After ?^ construction is omitted from the diagram. Operation 
completion of such setting, the set values are retained " the rotation of the motor is controlled m 

without any alteration unless the robot to be controlled conformity with the other acceleration-decelcration 
is chaneed curve of FIG. 4 (havmg a lower peak) by the control 

The peak time calculating means 4 consists of an l'^''^ W» f'?" the function computing means fa. 
energy computing means iid a Tp setting means 4& ^"f^ "f" °^ '^"'^ ^ " k prescnbed. 

The energy computing means 4a receives a constant „ ff^'l^'^f f '"'T"""' V 
setting signS S(CNS) from the constant setting means 3 " the descnption given hereinabove. eiAer of a 

J • 1 cmoixN f *i. \t plurality of driving axes havmg relationship of mutual 

or a command signal S(PRM) from the command means ^ interference, is moved with the allowable max- 

2. then executes the calculation of Eq. (23) m confor^ .^^ ^^^^ ^^^^ ^„ 

mity wi h the information thus received, and delivers energy and power distribution relative to the 

the resultant value of Tp(l) or Tp(2) to the Tp setting 3^ servo system, so that the capability of the driving source 

"^^If' , , can be fully utilized to the utmost extent and therefore 

The Tp settmg means 4i selects the greatest value as ^^^^ j^^^ ^ ^^^^ displacement. 

Tp according to Eq. (24) and sends a command signal Furthermore, due to the darity of its algorithm, the 

S(Tp) to the pattern generating means 5. jj^n^^l action is not dominated by any experimental 

The pattern gcneratmg means 5 consists of a function 35 j^ta or the experience of an operator or designer, 

computmg means Sa, a condition deciding means 5^, a accordance with the present invention, a minimum 

memory means 5c and a symmetnzmg means Sd number of experiments need be carried out since the 

The function computmg means 5a serves to compute dynamic constants (Al, A2. Bl, etc.) are calculated 

the function for generating a desired acceleration or fj-om the data based on the measurement according to 

deceleration pattern which conforms with the signal 40 Eqs. (16) through (18) without the use of Eq. (5). How- 

S(PRM) from the command means 2 or the signal S(Tp) gver. such experiments are based merely on the logical 

from the peak time calculating means. analysis, and the characteristics thereof reside in an 

Namely, the operation regarding the standard func- attempt to perform proper control for the actual action 

tion b performed as described in (C) above relative to of each arm. 

the acceleration and deceleration pattern generating 45 These characteristics are different for experiments 

method. conducted for the purpose of searching for modes of 

The memory means 5c and the symmetrizing means control. 

Sd are concerned with generation of a deceleration n is a matter of course that the present the invention 

pattern. is applicable in general to any servo system equipped 

More specifically, the velocity values relative to the 50 with a multiplidty of driving axes. In such instances, the 
acceleration pattern obtained by the function Comput- techniques is such that the power distribution for each 
ing means Sa are sequentially stored in the memory - driving axis is prescribed, the temporary peak time with 
means 5c in the order of the lapse of time, and in the regard to each axis on the basis of the maximum power 
subsequent deceleration period, the velocity values value per axis, is calculated, following which the great- 
stored in the memory 5c are sequentially read out there- 55 est value is selected as the peak time for the entire sys- 
from by the symmetrizing means 5^ in the order reverse tern, 
to the storage sequence, whereby a deceleration pattern What is claimed is: 

is generated. This procedure forms a deared decdera- i. An apparatus for generating acceleration and de- 

tion pattern where the changes of the velodty in the cderation patterns for a servo system having at least a 

accderation pattern are reflected with respect to the 60 first and second moveable axes, each of said first and 

time. second axes having an assodated drive means and 

The condition dedding means 5^ makes a decision wherein the motion of one of said moveable axes may 

over a control mode in response to the command signal exert dynamic interference with regard to motion of the 

S(PRM), in such a manner as to select, for example, one other of said moveable axes, the acceleration and decel- 

control mode for proceeding to deceleration from ac- 65 eration patterns for said first and second moveable axes 

celeration via fixed- velocity control when the result of having synchronized acceleration start points, velocity 

computing the angular velodty is prone to exceed the peak points and deceleration points, said apparatus com- 

allowable maximum value in the motor. After such a prising: 
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a constant setting means for setting dynamic con- 
stants speciflc to said servo system; 

a command means responsive to displacement in- 
structions for setting predetermined dynamic pa- 
rameters; 5 

peak time calculating means responsive to said con- 
stant setting means and said command means for 
calculating and setting the peak time required until 
a velocity peak is reached in the acceleration- 
deceleration pattern, said peak time calculating 
means including an energy computing means and 
peak time setting means, wherein said energy com- 
(rating means is operable for computing the total 
kinetic energy required for the conunanded dis- 
placement, as a function of the peak time on the 
basis of the dynamic constants and dynamic param- 
eters and for proscribing the power to be contrib- 
uted by each of said drive means, said energy com- 
puting means serving to proscribe which of the 20 
driving sources is to supply power to each energy 
term comprising said total kinetic energy, and for 
calculating the peak time when the energy from 

. each of the drive means is equal to the maximum 
power value allowable for said drive means, said 25 
peak time setting means being operable to set the 
maximum of the peak time values calculated by 
said energy computing means; and 

an acceleration-deceleration pattern generating 
means responsive to the peak time from said peak 
time setting means for generating an acceleration 
pattern whereby the time required for a velocity to 
reach a peak after an acceleration start point, is 
equal to the peak time from said peak time setting 
means, and for generating a deceleration pattern 
which is temporally symmetric with respect to said 
acceleration pattern, 

2. The apparatus according to claim 1, wherein said 
command means is operable to generate start and stop ^ 
and positions for each displacement of said moveable 
axes. 

3. The apparatus according to claim 1 wherein said 
dynamic constants include maximum output values for 
said driving means. 43 

4. The apparatus according to claim 1, wherein said 
total energy is calculated based on the equation: 



SO 



J [CI + a. costf2(/)i . wnp) * 



where: 



Al, A2, Bl, CI and C2 are dynamic constants specific 

to the geometry, mass and internal movement of 

the servo system. 
^1 is the angle formed by said first moveable axis with 

respect to the X-axis. ^ 
B2 is the angle formed by said second moveable axis 

with respect to said first moveable axis: 



18 
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5. A method of generating acceleration and decelera- 
tion patterns for a servo system having at least first and 
second moveable axes, each of said first and second axes 
having an associated drive means and wherein the mo- 
tion of one of said moveable axes may exert dynamic 
interference with regard to the motion of the other 
moveable axis, the acceleration and deceleration pat- 
terns for said first and second moveable axis having 
synchronized acceleration starts points, velocity peak 
points and deceleration end points, said method com- 
prising the steps of: 

(a) setting dynamic constants specific to the servo 
system and dynamic parameters, including start 
and end positions of each displacement of said 
moveable arms and expressing the dynamic param- 
eters as a function of the peak time required for the 
velocity in the acceleration-deceleration pattern to 
each a peak; 

(b) calculating, based on said dynamic constants and 
dynamic parameters, the total kinetic energy re- 
quired for the displacement and proscribing the 
power to be contributed by each of the drive means 
to each energy term comprising said total kinetic 
energy; 

(c) calculating the peak time when the energy term 
supphed with the power from each of the drive 
means is equal to a maximum allowable power 
value for said drive means; 

(d) selecting, as the peak time of said servo system, 
the maximum of the peak time values calculated; 
and 

(e) generating an acceleration pattern relative to each 
moveable axis whereby the time required for a 
velocity to reach a peak after an acceleration start 
point is equal to the peak time obtained m step (d), 
and generating a deceleration pattern which is 
temporally symmetric with respect to said acceler- 
ation pattern. 

6. The method according to claim 2, wherein said 
total energy is calculated based on the equation: 

where: 

Al, A2, Bl, CI and C2 are dynamic constants specific 

to the geometry, mass and internal movements of 

the servo system. 
B\ is the angle formed by said first moveable axis with 

respect to the X-axis. 
92 is the angle formed by said second moveable axis 

with respect to said first moveable axis: 



dBl 
dt 



65 
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